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(57) Abstract 




The invention relates to a method of controlling the movements of a robot and a workpiece manipulator during the teach- 
ing of the robot cell. To achieve synchronized teaching of the robot cell the method comprises driving one cell component that is. 
the robot (2) or the workpiece manipulator (1), to a position required by the following point (P3) to be taught, the other compo- 
nent following synchronously the moved one so that the position of the robot tool remains unchanged with respect to the work- 
piece; driving the other cell component, from the position of the point (PI) taught first to the following point (P3), corresponding 
to the position of the other component, and storing the coordinates of said point in the memory; and repeating said steps to teach 
all the required points of the paths to be taught. 
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1 

Synchronized teaching of a robot cell 



I . This invention relates to a method of con- 

I trolling the movements of a robot and a workpiece 

I 5 manipulator (rotary table) synchronously during the 

I teaching of the robot cell. 

I In prior art systems the robot and the rotary 

i table can be operated in synchronization with each 

f other when repeating a taught program path, thus 

I 10 obtaining a controlled path movement with respect to 

1 the workpiece positioned on the rotary table. The 

I systems enable complicated paths as compared with 

I systems with no synchronization. 

I A frequent problem associated with the teaching 

15 of this kind of robot system (cell) is that to avoid 
the risk of collision the robot usually has to be 
I displaced sufficiently far from the rotary table be- 

I fore each moving operation of the manipulator. There- 

j after the workpiece is turned into the desired posi- 

1 20 tion by means of the rotary table, and the tip point 

j of the tool has to be driven to the required posi- 

tion, which has to be stored in the memory of the 
i control system (cf. U.S. Patent 4,836.742. for 

I instance). This occurs frequently during the teach- 

j 25 ing, so the teaching is time-consuming as compared 

1 with a system which does not comprise a rotary table. 

I Also, the teaching of the points is difficult if 

there is little room available. A welding robot cell 
comprising, for instance, a robot of five to six 
30 degrees of freedom and a workpiece manipulator 
(rotary table) of one to two degrees of freedom is a 
typical example in this respect. 

The object of the present invention is to solve 
problems associated with the control of the movements 
35 of the robot and the rotary table during the teaching 
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Of the points. To achieve this, the method of the 
invention is characterized by the steps of driving 
one cell component, that is, the robot or the work- 
piece manipulator, to a position required by the 
following point to be taught while the other com- 
ponent follows synchronously the one that is moved in 
such a way that the position of the robot tool with 
respect to the workpiece remains unchanged; driving 
the other cell component, that is, the robot of the 
workpiece manipulator, from the position of the point 
taught first to the following point, corresponding to 
the position of the other component, and storing the 
coordinates of said point in the memory; and repeat- 
ing the steps c to d until all the required points of 
the paths to be taught have been taught. 

The other preferred embodiments of the inven- 
tion are characterized by what is disclosed in the 
attached claims. 

In the following the invention will be de- 
scribed in greater detail by means of an example and 
with reference to the attached drawings, wherein 

Figure 1 is a perspective view of a robot cell; 

Figure 2 shows a reduced model of the robot, 
cell of Figure 1; 

Figure 3 is a block diagram of a robot cell 
control system; and 

Figure 4 shows the operation of the different 
components of the robot cell during teaching. 

The systematic use of the method of the inven- 
tion requires that the robot cell comprises a robot 
of at least three degrees of freedom, a rotary table 
of at least one degree of freedom, and a control unit 
controlling the robot and the table. 

Figure 1 shov/s one specific system for 
realizing the synchronized teaching according to the 
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invention. In this arrangement a workpiece is 
attached to the rotary table 1 and a required tool to 
the robot 2, or vice versa. In the following example, 
the workpiece is attached to the rotary table, and 
5 the tool, in this case a welding burner 3, to the 
tool flange of the robot. 

The joints of the robot and the rotary table 
may be e.g. rotary- type joints or linear joints • In 
this particular case the robot 2 is a joint mechanism 

10 of six degrees of freedom, in which all the joints 
are rotary joints. The axes of rotation of the joints 
are indicated Jl, 02, J3, 34, 35, J6- The rotary 
table 2 comprises two rotary joints the axes of which 
are indicated 37 (turning) and J8 (rotation). As is 

15 known from the prior art, each joint comprises a 
motor which can be operated through a respective 
joint servo. To read the position of the joint, the 
motors comprise absolute encoders from which signals 
are applied to the respective joint servos. These 

20 components are known from the prior art and are not 
shown in Figure 1. 

Figure 2 shows a reduced model of the 
arrangement of Figure 1. The position of the rotary 
table is represented by a rectangular coordinate 

25 system T, a rectangular coordinate system W is posi- 
tioned in the fastening base of the robot; and a 
rectangular coordinate system P is positioned at the 
tip of the tool. The position of the coordinate 
system T is determined by the joint angles of the 

30 axes of the rotary table. 

The direction of the coordinate system W of the 
robot 2 is selected so that the z axis is set in 
parallel with the joint 31, the y axis in parallel 
with the joint 32 when the joint angle of Jl is equal 

35 to 0, and the x axis is set perpendicular to the 
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otherd axes. The origin of the coordinate system W is 
positioned at the intersection B of the axes Jl and 
J2. 

The 2 axis of the coordinate system of the 
5 rotary table 1 points in the direction of the axis J8 
(« the direction of Jl); and the x axis is set in 
parallel with the axis J7 and with the x axis of the 
coordinate system W when the axis J8 is at an angle 
of 0, The origin of the coordinate system T is at the 
10 intersection A of the axes J7 and J8 (cf- Figure 1). 

The position and orientation of the coordinate 
system P of the tool with respect to the coordinate 
system W depend on the joint angles Jl to J6 of the 
robot; the origin of the coordinate system of the 
15 tool is positioned gt the tip point of the tool. 

Path teaching according to the invention takes 
place point by point by first driving the tip point 4 
of the tool by means of a manual control to a desired 
point- Thereafter the operator may change the orien- 
20 tation between the tool and the workpiece by oper- 
ating the joints of the rotary table in synchroniza- 
tion with the robot. In welding, for instance, it is 
thus possible to find the right burner angle with 
respect to the v;orkpiece to be welded without having 
25 to displace the robot to a safety distance and back 
because the orientation of the tool remains constant 
with respect to the coordinate system W due to the 
synchronization . 

When the rotary table is operated synchronously 
30 with the robot, the path calculation is performed 
with respect to the coordinate system T in place of 
the coordinate system The calculation unit of the 
control system performs the required transformations 
from the coordinate system W to the coordinate system 
35 T and vice versa. When operating the joints of the 



-eNSOCX:iD: <WO 9104S22A1 .l> 



PCT/FI90/00192 



5 

rotary table during the teaching, the control unit 
keeps the tip point of the tool in a constant posi- 
tion with respect to the v;orkpiece positioned on the 
rotary table. The orientation of the tool can be kept 
constant either with respect to the coordinate system 
whereby the tool remains in the same position with 
respect to the workpiece when operating the joints of 
the rotary table, or with respect to the coordinate 
system W, whereby the top of the tool remains in the 
same position with respect to the workpiece. 

During one calculation period the synchronized 
teaching movements are calculated through the follow-- 
ing steps: 

- calculating the position Pw of the tool in 
the coordinate system W on the basis of the joint 
angles of the robot or utilizing the tool position 
calculated during the preceding calculation period, 

- transforming the point Pw from the coordinate 
system W to the coordinate system T (point Pt ) , 

- adding to the joint angles of the rotary 
table the angle of change required by the driving 
speed, 

- calculating the position of the point Pt in 
the coordinate system W using the new joint angles of 
the rotary table (point Pw2), 

- calculating new joint angles for the robot on 
the basis of the point Pw2, 

The duration of the calculation period is 
constant, typically some tens of milliseconds. 

When performing synchronized teaching move- 
ments, the control unit calculates, during each cal- 
culation period, the position Pw of the tool in the 
coordinate system W at this particular moment. The 
point P can be presented in the form of a transforma- 
tion matrix 
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where vector (px^py^pz) = position of the origin of 

the point 

10 vector (nx^ny.nz) = the x axis of the co- 

ordinate system of the 
tool at the point P 
vector (ox,oy,oz) « the y axis of the co- 
ordinate system of the 
15 tool at the point P 

vector (ax,ay,az) « the z axis of the co- 
ordinate system of the 
tool at the point P 
The transformation of the point Pw from the co- 
20 ordinate system W to the coordinate system T takes 
place by multiplying the point Pw by the inverse mat- 
rix T' of the transformation matrix T describing the 
position and orientation of the coordinate system T 



25 



Pt « T'*Pw 



30 



The matrix T is easy to determine when the po- 
sition- of the origin of the coordinate system T in 
the coordinate system W and the joint angles J7, J 8 
of the axes of the rotary table are known 
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I where C7 » cos(J7) 

I C8 « cos(J8) 

I • S7 « sin(J7) 

I SB « sin(J8) 

5 vector (px^py^pz) = position of the origin of 

I the coordinate system T in 

the coordinate system W 

The transformation of the point Pt back to the 
10 coordinate system W is carried out as follows 

I 
I 

I Pw2 = T*Pt 

I If the orientation of the tool is to be kept 

I constant with respect to the coordinate system W, the 

15 position vector (px,py,p2) of the calculated point 
Pw2 Is used, and when calculating orientation vectors 
for the point Pw, the joint angles Jl to J6 of the 
robot are used. If the orientation of the tool is to 
be kept constant with respect to the coordinate 

20 system T, the joint angles Jl to J6 of the robot can 
be calculated directly from the point Pw2. 
I Figure 3 shows the robot cell control system by 

means of which the robot and the rotary table can be 
operated simultaneously. It is formed by a calcula- 

25 tion unit 5 and its program storage 6 which together 
form a data processing unit 4 indicated with broken 
lines; a manual control panel 7; and joint servos 8 
connected to respective motors 9 and encoders 10 for 
the robot and the rotary table. Each joint servo 8 

30 controls irs joint Jl to J8 in response to instruc- 
tions received from the calculation unit 5. The cal- 
culation unit may, for instance, instruct a de- 
termined joint serve 8 to drive up to a desired en- 
coder reading. 

35 Figure 4 shovjs a practical situation. In the 
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left a welding burner 3 is attached to the arm of the 
robot 2. An arbitrary workpiece not shown is attached 
to the rotary table 1 by means of a jig or the like. 
The point PI of the v;orkpiece has just been taught to 
5 the robot cell by steering the welding burner 3 
manually to a suitable position with respect to the 
rotary table 1. In the right the rotary table 1 has 
been turned with respect to the axis J7 of Figure 2 
over a determined distance for the point to be taught 

10 next. Due to the synchronization according to the 
invention the arm of the robot 2 thereby automatical- 
ly follows the movement of the rotary table 1 to the 
point P2, in which the position of the tip of the 
welding burner 3 is constant with respect to the 

15 workpiece (not shown). As mentioned above, the teach- 
ing may also be such that the orientation of the tool 
remains constant with respect to the workpiece* The 
new point P3 can nov; be taught to the system by 
driving the v/elding burner 3 by means of the robot to 

20 a new position, possibly by changing the position of 
the burner 3, into the point P3 shown in the figure. 
This is repeated until all the points PI to Pn re- 
quired for achieving a desired path are taught. 

It is obvious to one skilled in the art that 

25 the different embodiments of the invention are not 
limited to the above examples, but they can vary 
within the scope of the attached claims. 
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Claims: 

1. A method of controlling the movements of a 
robot and a workpiece manipulator during the teaching 

5 of the robot cell, wherein the robot cell is taught 
paths required for machining operations to be per- 
formed on a workpiece attached to the workpiece 
manipulator by driving the tool (3) of the robot (2) 
to the different points of the workpiece to be taught 
10 and by storing the coordinates of the points in a 
memory, the method comprising the steps of: 

a) driving the tool (3) of the robot to a. work- 
piece point (PI) to be machined first; 

b) storing the coordinates of the first work- 
15 piece point in the memory (6) of the control system 

of the robot cell; 

characterized by the steps of 

c) driving one cell component, that is, the 
robot (2) or the workpiece manipulator (1), to a po- 

20 si1:ion required by the following point (P3) to be 
taught while the other component follows synchronous- 
ly the one that is moved in such a way that the posi- 
tion of the robot tool with respect to the workpiece 
remains unchanged; 

25 d) driving the other cell component, that is, 

the robot (2) of the workpiece manipulator (1), from 
the position of the point (PI) taught first to the 
following point ( P3 ) , corresponding to the position 
of the other component, and storing the coordinates 

30 of said point in the memory; and 

e) repeating the steps c to d until all the 
required points of the paths to be taught have been 
taught . 

2. A method according to claim 1, charac- 
35 terized in that mainly the workpiece 
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manipulator (1) is controlled during the teaching so 
as to turn the workpiece to a suitable position for 
the point to be taught next, and that mainly the 
robot (2) is synchronized with the movements of the 
5 workpiece manipulator during the teaching. 

3, A method according to claim 1, charac- 
terized in that mainly the robot (2) and its 
tool (3) are controlled during the teaching so that 
they point the coordinates of the point to be taught 
10 next, and that mainly the workpiece manipulator (1) 
is synchronized with the movements of the robot 
during the teaching. 
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